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Abstract.  This  paper  describes  a  method  by  which  range  data  from  a  sonar  or 
other  type  of  rangefinder  can  be  used  to  determine  the  2-dimensional  position  and 
orientat  ion  of  a  mobile  robot  inside  a  room.  The  plan  of  the  room  is  modeled  as  a 
I ist  of  segments  indicating  the  positions  of  walls.  The  method  works  by  extracting 
straight  segments  from  the  range  data  and  examining  all  hypotheses  about  pairings 
between  the  segments  and  walls  in  the  model  of  the  room.  Inconsistent  pairings 
are  discarded  efficiently  by  using  local  constraints  based  on  distances  between  walls, 
angles  between  wall*.  and  ranges  between  walls  along  their  normal  vectors.  These 
c oust  raints  are  used  to  obtain  a  small  set  of  possible  positions,  which  is  further  pruned 
using  a  test  for  physical  consistency.  The  approach  is  extremely  tolerant  of  noise  and 
clutter.  Transient  objects  such  as  furniture  and  people  need  not  be  included  in  the 
room  model,  and  very  noisy,  low-resolution  sensors  can  be  used.  The  algorithm’s 
performance  is  demonstrated  using  a  Polaroid  Ultrasonic  Rangefinder,  which  is  a 
low-resolution,  high-noise  sensor. 
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along  their  normal  vectors.  These  constraints  are  used  to  obtain  a  small 
set  of  possible  positions.  Which  is  further  pruned  using  a  test  for  physical 
consistency.  The  approach  is  extremely  tolerant  of  noise  and  clutter.  Transient 
objects  such  as  furniture  and  people  need  not  be  included  in  the  room  model, 
and  very  noisy,  low-resolution  sensors  can  be  used.  The  algoithm’s  performance 
is  demonstrated  using  a  Polaroid  Ultrasonic  Rangefinder,  which  is  a  low-resolution, 
high-noise  sensor. 
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1  Problem  Definition 

The  specific  problem  considered  in  this  paper  is  that  of  enabling  a  mobile  robot 
to  determine  its  position  and  orientation  (its  configuration )  inside  a  building  m  a  way 
independent  of  assumptions  about  its  previous  movements.  This  ability  will  be  called 
absolute  localization ,  or  simply  localization.  Localizat  ion  is  the  direct  measurement  of 
vehicle  position.  It  is  to  be  contrasted  with  dead-reckoning ,  or  trajectory  integration. 
which  is  the  process  of  measuring  a  vehicle's  velocity  relative  to  nearby  stationary  ob¬ 
jects  (the  ground,  for  example),  and  deducing  the  vehicle's  position  from  its  velocity 
history. 

Since  the  errors  encountered  in  dead-reckoning  are  cumulative,  a  robot,  that  nav¬ 
igates  bv  dead-reckoning  alone  will  event  ually  lose  track  of  its  position.  Ultimately, 
this  can  be  prevented  only  by  periodically  re-establishing  the  absolute  position  of 
the  robot.  Therefore  a  means  of  localization  is  necessary  for  safe,  reliable  robot  nav¬ 
igation.  Mobile  robots  that  will  someday  be  operating  in  factories,  offices,  homes, 
hospitals,  etc.,  will  need  a  reliable  means  of  localization. 

Some  solutions  to  this  problem  have  been  proposed  that  require  modifications 
to  the  environment,  such  as  triangulation  from  infra-red  beacons  jCiralt,  Sobek, 
K  Chatila  79,.  It  would  be  desirable  to  solve  the  problem  without  modifying  the 
environment.  Furthermore,  most  of  the  mobile  robot  navigation  schemes  developed 
so  far.  such  as  in  |Moravec  8 1  ] ,  are  essentially  dead-reckoning  methods,  which  lack 
any  provision  for  periodically  localizing  the  robot.  Such  schemes  could  benefit  from 
the  addition  of  a  moans  of  localization. 

In  the  localization  approach  described  in  this  paper,  the  robot  s  environment  is  a 
room  or  area  inside  a  building.  The  environment  could  include  the  wdiole  building. 
The  robot’s  user  must  provide  a  model  of  the  room  consisting  of  a  list  of  segments  in¬ 
dicating  t  he  locations  of  walls.  Such  a  model  is  easily  constructed  from  an  architect’s 
drawing  or  with  a  tape  measure. 

The  rangefinding  device  used  in  this  paper  is  a  Polaroid  Ultrasonic  Rangefinder, 
bui  am  rangefinder  may  be  used  (see.  for  example,  (Jarvis  83 j  and  (Thompson  79:). 
We  will  henceforth  call  ultrasonic  rangefinding  sonar  for  short. 

The  dosed  contour  obtained  by  a  .‘{(K)-degree  sw'eep  with  a  sonar  beacon  will  be 
called  a  sonar  contour.  The  lines  drawn  from  the  robot,  position  to  the  individual 
data  points  in  the  sonar  contour  represent  individual  range  readings,  and  are  called 
.■sonar  ray.-*. 

Figure  I  shows  a  typical  room  outline,  a  typical  sonar  contour  obtained  from 
inside  the  room,  and  the*  corresponding  localization  as  determined  by  the  algorithm. 

2  Approach 

Some  recent  papers  ((Crimson  &  Lozano- Perez  83|  and  |Caston  &  Lozano-Perez 
81]),  have  introduced  a  new  approach  to  object  recognition  and  localization  based  on 
exploit  ing  simple  geometric  constraints  between  sensed  data  and  a  model.  Sections 
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Figure  1:  A  typical  room,  a  sonar  contour  obtained  from  inside  the  room,  and  the 
localization  produced  by  the  algorithm.  Note  the  printed  numerical  results 

2.1.  2.5.  and  2.7  are  based  largely  on  the  object  recognition  method  described  in 
Crimson  A  Lozano- Perez  83.  841  and  |Gaston  A  Lozano-Percz  84 j.  The  main  differ¬ 
ence  between  these  sections  and  these  papers  is  the  use  of  sonar  segments,  which  are 
straight  segments  extracted  from  a  sonar  contour  by  a  simple  line-fitting  algorithm, 
instead  of  position  normal-vector  pairs,  as  the  primary  inputs  to  the  algorithm. 

'Phis  paper  introduces  a  new  idea,  called  the  sonar  barrier  test,  in  section  2.(».  The 
sonar  barrier  test  checks  for  physical  consistency  bv  determining  whether  the  shape 
of  a  sonar  contour  for  a  proposed  localization  is  consistent  with  the  simple  fact  that 
sonar  beams  do  not  penetrate  solid  objects.  If  an  inconsistency  is  found,  the  proposed 
localization  is  discarded.  The  sonar  barrier  test  makes  possible  overall  algorithm 
performance  that  is  superior  to  w  hat,  was  obtainable  using  only  the  methods  described 
in  {Crimson  A  Lozano- Perez  83.  84i  and  {Gaston  A  Lozano- Perez  84 j. 

■Miller  84 i  also  describes  an  approach  to  robot  localization  using  sonar,  following 
the  methods  of  Crimson  A  Lozano-Perez  83,  84j  and  {Gaston  A  Lozano-Percz  84:. 
The  method  described. in  'Miller  84 i  uses  single  sonar  rays  instead  of  larger  data 
features  as  the  primary  inputs  to  the  algorithm,  and  it  uses  a  different  set  of  local 
geometric  constraints.  Nothing  analogous  to  the  sonar  barrier  test  is  presented,  and 
only  one  experimental  result  is  shown. 

Our  approach  is  to  consider  the  localization  process  to  be  a  2-dimensional  match¬ 
ing  (including  rotation)  between  the  sonar  contour  and  the  room  outline.  We  wish 


Figure  2:  Some  straight  segments  extracted  from  a  typical  sonar  contour. 

to  determine  the  geometrical  relationship  between  the  robot  and  the  room.  The  con¬ 
figuration  of  the  robot  relative  to  the  sonar  contour  is  always  known,  so  if  we  can 
determine  a  possible  configuration  for  the  sonar  contour  relative  to  the  room  outline, 
then  we  will  have  found  a  possible  configuration  for  the  robot  inside  the  room. 

The  goal  of  the  localization  process,  therefore,  is  to  find  possible  matches  of  the 
sonar  contour  to  the  room  outline.  We  proceed  in  four  steps: 

1.  Extract  straight  line  segments  from  the  sonar  data:  Straight  segments 
extracted  from  a  sonar  trace  are  called  sonar  segments.  An  example  of  some 
sonar  segments  extracted  from  a  sonar  contour  is  shown  in  Figure  2.  The 
matching  process  is  initially  driven  entirely  from  the  sonar  segments,  which  are 
usually  the  sonar  images  of  walls. 

2.  Generate  feasible  interpretations:  A  set  of  feasible  interpretations  of  the 
sonar  segments  is  constructed.  An  interpretation  is  a  set  of  ordered  pairs  of 
sonar  segments  and  walls,  where  |(se0,  xvallWi )  (segj  watlw>) . . .),  means  “it 
is  feasible  that  segi  could  be  the  sonar  image  of  wallVi,  seg ;  could  be  the 
sonar  image  of  wallWj,  etc..”  Interpretations  that  are  inconsistent  with  local 
constraints  (derived  from  the  model)  on  the  sonar  segments  are  discarded. 

3.  Global  Model  Tfest:  The  feasible  interpretations  are  tested  for  consistency 
with  the  equations  of  the  walls  in  the  model.  An  interpretation  is  admissible 
if  it  is  possible  to  find  a  rotation  and  translation  of  the  sonar  contour  that 
would  superpose  each  sonar  segment  over  the  wall  with  which  it  is  paired,  while 
keeping  the  sensor  inside  the  room  and  the  sonar  segment  endpoints  within  the 
limits  of  the  wall  endpoints. 
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4.  Sonar  Barrier  Test:  An  interpretation  may  represent,  a  geometrically  feasible 
configuration  for  the  sonar  segments  alone,  but  an  impossible  configuration  for 
the  entire  sonar  contour.  In  particular,  each  interpretation  that  survives  the 
global  model  test  must  also  pass  the  sonar  barrier  test,  namely:  an  admissible 
robot  configuration  must  not  imply  that  any  sonar  ray  penetrates  a  known  solid 
object. 

The  second  step  is  the  key  to  the  process.  The  number  of  possible  interpreta¬ 
tions,  given  ,s  sonar  segments  from  the  sonar  contour  and  n  walls  in  the  model,  is  n\ 
Since  the  global  model  test  and  the  sonar  barrier  test  are  computationally  expensive 
processes,  it  would  be  impractical  to  perform  each  of  them  on  all  possible  interpreta¬ 
tions.  [Crimson  84]  shows  that  the  number  of  feasible  interpretations  can  be  reduc  ed 
to  manageable  numbers  through  the  use  of  local  geometric  constraints. 

2.1  The  Rangefinder  and  Rangefinding  Error 

The  Polaroid  Ultrasonic  Rangefinder  was  chosen  for  this  research  because  of  its 
simplicity,  availability,  and  low  cost.  It  consists  of  an  ultrasonic  transmitter,  a  mi¬ 
crophone,  and  a  timing  mechanism.  The  transmitter  and  microphone  functions  are 
performed  by  a  single  physical  transducer.  Range  information  is  obtained  by  broad¬ 
casting  a  pulse  of  ultrasound  and  measuring  the  elapsed  time  until  an  echo  is  received. 
The  Polaroid  Ultrasonic  Rangefinder  is  described  in  detail  in  [Polaroid].  Other  suit¬ 
able  rangefinding  devices  are  described  in  iMassaj  and  [Jarvis  83j. 

There  are  several  sources  of  error  that  can  corrupt  sonar  range  data.  These  are 
discussed  in  the  following  paragraphs. 

2.1.1  Errors  Due  to  the  Shape  of  the  Sonar  Beam 

The  beam  pattern  of  the  Polaroid  device  is  similar  to  the  complicated  multi-lolx  d 
pattern  produced  by  anv  circular-disk  acoustic  emitter.  For  simplicity,  however,  we 
model  the  beam  as  cone-shaped.  (See  Figure  3.) 

When  the  Polaroid  device  is  aimed  perpendicular  to  a  fial  surface  it  reports  tin 
true  range  to  the  surface  to  within  about  one-half  of  an  inch.  However,  the  range  error 
can  be  much  larger  when  the  beam  strikes  a  surface  with  a  large  angle  of  incidence. 
'Phe  reason  is  that  the  edge  of  the  wavefront  is  reflected  back  to  tin  sensor  instead  of 
the  centerline  (see  Figure  4).  This  effect,  called  radial  error,  often  results  in  errors 
greater  than  one  foot. 

Because  of  the  large  beam  w  idth  (the  beam  has  a  half-angle  li  of  about  1  ■">  degrees), 
the  rangefinder  tends  to  produce  a  blurred  image  of  its  surroundings.  This  effect, 
called  angular  error,  is  similar  to  convolving  a  range  contour  obtained  by  a  perfect 
rangefinder  with  a  pulse  whose  width  is  proportional  to  the  range  being  measured. 

For  simplicity,  we  will  henceforth  lump  radial  and  angular  errors  together,  mod¬ 
elling  their  combination  as  unpredictable  but  bounded  by  a  constant  E;  thus  we 
assume  that  the  location  of  the  endpoint  of  any  particular  sonar  ray  may  be  in  error 
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Figure  3:  Cone-shaped  approximation  of  actual  multi-lobed  beam  pattern. 


Figure  1:  Hanging  error  can  be  caused  by  edge-of-beam  reflection. 

by  as  much  as  E.  The  arlual  value  of  E,  which  is  determined  empirically,  will  he 
discussed  in  ihe  Results  section. 


2.1.2  False  Reflections 

Rased  upon  the  preceding  discussions,  one  might  think  it  possible  to  extract, 
with  reasonable  accuracy,  the  room  outline  from  the  sonar  contour  by  means  of 
a  deconvolut  ion  process.  However,  the  nature  of  ultrasound  reflections  makes  this 
\  irt  ually  impossible-. 

The  pulse  emitted  from  the  Polaroid  device  has  a  frequency  of  about  55  kHz  and 
a  wavelength  of  about  a  quarter  of  an  inch.  Therefore,  unless  the  sensed  surface  has 
irregularit  ies  w  hose  size  is  of  the  same  order,  the  sonar  beam  will  not  be  scattered. 
It  may  bounce  off  into  oblivion  after  striking  the  surface  at  a  large  angle  of  incidence, 
instead  of  reflecting  a  strong  echo  back  to  the  sonar  receiver.  This  effect,  called  false 
reflections .  occurs  whenever  the  incidence  angle  of  the  beam,  called  0,  is  greater  than 
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CONE  OF  REFuEGTION 


a  critical  angle  called  which  defines  the  rone  of  reflection  (CR)  for  the  surface  (see 
Figure  5).  A  sonar  beam  striking  a  wall  from  inside  the  CR  will  reflect  back  to  the 
sensor  with  sufficient  strength  to  produce  an  accurate  range  reading.  A  beam  striking 
the  wall  from  outside  the  CR  will  be  reflected  away  from  the  sensor,  producing  an 
unrealistically  long  sonar  ray.  The  sonar  beam  thereby  apparently  penetrates  the 
wall.  An  example  of  this  effect  may  be  seen  as  the  sharp  “horn”  jutting  out  of  the 
sonar  contour  in  Figure  1. 

Every  surface  material  has  its  own  CR  half-angle,  which  may  range  from  seven 
or  eight  degrees  (for  glass)  to  nearly  ninety  degrees  for  rough  surfaces. 

2.2  Clutter 

Another  source  of  error  that  the  localization  method  must  overcome  is  clutter. 
Clutter  is  any  object  that  t. s  not  included  in  the  room  model.  Clutter  often  distorts 
sonar  contours  so  much  that  they  bear  almost  no  overall  resemblance  to  the  room 
outline.  We  will  show  that  the  approach  described  here  is  very  effective  at  ignoring 
clutter. 


2.3  Extracting  Straight  Line  Segments 

A  sonar  contour  consists  of  100  range  readings,  taken  from  a  single  position  in 
the  room,  at  3.6-degree  angular  intervals.  The  sensor  was  mounted  at  an  altitude 
of  r>..r>  feet  on  a  stepper-motor  driven  “head,”  which  could  posit  ion  the  sensor  under 
computer  control. 

The  straight-line  finder  used  for  extracting  straight  segments  from  a  contour  is 
the  "iterative  endpoint  lit,”  desciibed  in  'Ballard  &•  Brown  82!.  This  algorithm 
extracts  the  contiguous  non-overlapping  subcontours  from  a  sonar  contour  that  best 
approximate  straight  segments.  (A  contiguous  subconlour  is  a  group  of  sonar  ra> 
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Figure  5:  An  example,  of  an  interpret al ion  tree  for  a  J-wall  room  model  and  a  S-seg- 
ment  sonar  contour. 

endpoints  that  occur  consecutively  in  the  sonar  contour.)  The  algorithm  has  two 
operat  ing  parameters,  N  and  <*>;  it  finds  the  set  of  longest  non-overlapping  contiguous 
mi  hr  on*  ours  containing  at  least  A'  points,  and  having  no  point  farther  than  b  from 
the  line  passing  through  the  endpoints  of  the  subcontour. 

2.4  Generating  Feasible  Interpretations 

After  obtaining  a  sonar  contour  and  extracting  the  sonar  segments,  we  have  up 
to  *  sonar  segments  .S',,  and  we  seek  a  geometrically  consistent  pairing  of  these  sonar 
segments  with  some  number  k  of  the  n  walls  that  comprise  the  model  of  the  building. 
For  now  we  will  assume  that  all  the  sonar  segmenls  arc  sonar  images  of  walls.  (This 
is  not  necessarily  the  case,  since  a  piece  of  furniture  or  other  clutter,  or  even  sensor 
noise,  may  give  rise  to  a  sonar  segment  that  cannot  be  interpreted  as  the  sonar 
image  of  any  wall.  We  will  address  this  issue  later  in  this  paper.)  The  range  of 
possible  interpretations  can  now  be  cast  in  the  form  of  an  interpretation  tree  (IT),  an 
example  of  which  is  shown  in  Figure  (i.  The  root  node  of  the  IT  has  n  descendants, 
each  representing  an  interpretation  in  which  .S',  is  the  sonar  image  of  a  different  wall 
in  the  room  model.  There  area  total  of  *  levels  in  the  tree.  A  node  at  level  /  indicates 
one  set  of  possible  pairings  of  sonar  segments  .S’,  through  .S',  with  the  walls  of  the 
room. 

2.5  Pruning  the  IT  Using  Local  Constraints 

Only  a  small  number  of  the  interpretations  in  the  IT  are  geometrically  consistent 
with  t lie  sonar  contour.  Wo  can  exploit  the  following  local  constraints  to  prune  the 
in<  onsistent  interpretations: 

f.  Distance  Constraint  The  range  of  possible  distances  between  points  on 
a  pair  of  sonar  segments,  taking  sensor  error  into  account,  must  overlap  the 
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Figure  7:  The  range  of  distances  between  wall  pairs  and  sonar  segment  pairs. 

range  of  distances  between  the  pair  of  walls  that  they  are  assigned  to  in  an 
interpretation. 

Consider  the  pair  of  walls  Wm  and  W7,,  and  the  pair  of  sonar  segments  .S’,  and 
S:  in  Figure  7.  The  range  of  distances  between  Wm  and  W’ri  is  \A,B\.  and 
the  range  of  distances  between  S,  and  Sj  is  |C,  I)\,  where  A ,  B,  C.  and  l)  arc* 
defined  by  Figure  7  for  this  situation.  (.4,  H,  C,  and  D  can  be  calculated  easily 
for  any  pairs  of  sonar  segments  and  walls.)  However,  the  range'  C,  1) j  does  not 
take  sensor  error  into  account.  Using  our  simple  bounding-constant  model  of 
rangefinder  error,  the  range  of  possible  distances  between  S’,  and  Sj  becomes 
\{C  •  2K),(D  t  2E)\. 

Therefore  if  an  interpretation  assigns  S’,  to  H  „,  and  Sj  to  VV„,  then  it  must  be 
true  that  (!)  2E)  ■'  B  and  (C  -c  2 E)  >  A  for  the  interpretation  to  be  feasible. 

2.  Angle  Constraint  The  range  of  possible  angle's  hoi  ween  a  pair  of  sonar  seg¬ 
ments.  taking  sensor  error  into  account,  must  include  the  known  angle  between 
the  pair  of  walls  that  they  art'  assigned  to  in  an  interpretation. 

Figure  8  shows  that  since  am  sonar  measurement  can  be  in  error  In  as  much 
as  E.  then  am  sonar  segrrienl  .S’.  ma\  be  regarded  a~  ipovdblx)  the  image  of 
some  straight  object  having  a  minimum  length  <1,  and  occupying  any  position 
inside  the  dashed  line'  surrounding  .s’,.  '1'hc'  orientation  of  S’,  can  b<'  seen  to 
be  in  error  by  as  much  as  <•>,.  Thus  the  range  of  possible  angles  between  two 
sonar  segments  .S’,  and  Sj  is  ;(0  (d>,  <?,-)).  (fl  1  ( «.>,  •  <n.))  .  If  tlx'  known  angle 

between  H’„,  and  IV„  is  c»m„,  then  an  interpretation  assigning  .S’,  to  IT,,,  and  St 
to  VVn  is  feasible  only  if  ( 0  (4>,  t  6j))  o,„„  •  ( 0  I  (o,  >  <hj)). 

In  practice,  the  above  geometrical  construction  for  computing  the  angular  error 
of  a  sonar  segment  is  unrealistic  for  sonar  segments  whose  lenglh  is  of  the 
same  order  as  E.  Therefore,  it  is  useful  to  place  an  upper  bound  E,  eui  the1 
angular  erre>r  for  a  sonar  se'gment.  The  actual  value  e»f  E,:. ,  which  appears  in 
the  Results  section,  is  determined  empirically  by  estimating  its  value  in  several 
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Figure  S:  Calculating  the  angular  error  0,  for  a  sonar  segment  St:  .S',  is  possibly  the 
image  of  a  straight  object  of  minimum  length  d,,  occupying  any  position  inside  the 
dashed  line.  Therefore,  the  orientation  of  S,  may  be  in  error  by  as  much  as  0,,  as 
shown. 

sonar  contours. 

Note  that  any  wall  or  sonar  segment  P,  has  an  inward-pointing  normal  vector, 
ii j >, ,  whose  positive  direction  is  toward  the  inside  of  the  room  or  toward  the 
sensor.  It  is  t  hus  natural  to  define  the  angle  between  two  walls  or  sonar  segments 
as  the  inner  product  of  their  normal  vectors.  However,  this  definition  provides 
less  geometric  constraint  than  is  really  available.  Consider  Figure  9.  The  inner 
product  of  the  normal  vectors  of  sonar  segments  .S',,  and  .S',,  is  the  same  as  that, 
for  walls  U  r  and  H  „.  It  is  clear  from  the  figure,  however,  that  it  would  not  make 
sense  to  assign  .S',  to  IF,  and  S),  to  M’„.  For  this  reason,  we  define  the  directed 
angle  between  two  walls  or  sonar  segments  P,  and  P,  to  be  the  pair  of  numbers 
|  A,j .  Il,j ).  where  A,,  is  the  component  of  l\'s  inward-pointing  normal  vector 
fly  in  1  he*  direction  of  fly  .  and  HtJ  is  the  component  of  riy  in  the  direction  to 
the  right  ol  fly  .  Defined  in  this  way.  the  directed  angle  between  .S',  and  ,S y  is 
not  equal  to  that  between  M  ,  and  It  y. 

■].  Normal-Direct  ion  Constraint  This  constraint  is  most  easily  explained  us¬ 
ing  an  illustration  (see  Figure  10).  Sonar  segments  and  .S'/,  survive  tin1 
distance-  and  angle-constraints  for  the  interpretations  (.S',,  IT,, ) ( .S'/,  VTr)!  and 
(>,  n,)(s  u  )  .  It  is  (  lear.  however,  that  only  the  latter  interpretation  is 
geomet  ri( ally  consistent.  This  is  because  the  range  of  distances  between  a  pair 
of  sonar  segments  .S’,  and  .S’  m  the  direction  of  each  sonar  segment  irurard- 
poinimg  normal  vector  must  fie  consistent  with  the  similar  range  for  any  pair  of 
walls  IT,,  and  IT,,.  In  Figure  10  we  can  see  that  the  range  of  distances  from  Sj 
to  Si,  along  fis  is  consistent  with  the  range  of  distances  from  H  v  to  lTr  along 
fin  .  but  it  is  not  consistent  with  the  similar  range  from  14  , v  to  H  ... 

This  ‘normal  diredion  range"  is  computed  straightforwardly  for  pairs  of  walls. 
I  he  position  error  K  and  the  angular  error  must  both  be  included  when 
computing  this  range  for  a  pair  of  sonar  segments.  'This  may  be  quickly  approx¬ 
imated  l»>  considering  t  he  maxima  and  minima  of  the  normal  ranges  occurring 
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Figure  9:  A  situation  illustrating  the  usefulness  of  the  directed  angle  concept. 

in  a  few  extreme  cases  of  possible  sonar  segment  orientations  and  positions 
relative  to  walls. 

The  local  constraints  described  above  are  described  in  greater  detail  in  Gaston 
&:  Lozano-Perez  83j,  Crimson  &  Lozano-Perez  83],  |Grimson  84 j ,  and  ]I)rumbeller 
84]. 

Using  these  constraints,  the  IT  is  expanded  in  the  following  way:  At  the  first  level 
in  the  IT,  .S’,  is  allowed  to  be  paired  with  each  wall  that  is  longer  than  it,  since  none  of 
the  above  local  constraints  (which  are  ail  pairwise)  applies  to  solitary  sonar  segments. 
Below  the  j(.S',  lV,)j  node  at  the  second  level,  S-2  is  paired  with  each  wall  \\ f  that  is 
consistent,  based  on  the  local  constraints,  with  the  pairings  j ( .S',  IV, ) ( S2  VP,)].  Below 
the  node  (.Sj  VV’,)(.S'2  IF*)  at  the  third  level,  S2  is  paired  with  each  wall  IV,  that  is 
consistent  with  the  pairings  (.S',  W, ) ( IV', ))  and  i ( -S*2  IV'*. )  ( S2  W,)l.  Note  that  for  a 
segment-wall  pairing  to  be  consistent,  it  must  be  consistent  with  even  pairing  thal 
leads  to  it  on  a  path  through  the  IT.  Thus,  for  a  three-segment  interpretation  the 
local  constraints  must  be  applied  to  three  segmenl-wal)  pairings,  and  in  general 
pairings  for  k  sonar  segments. 

The  above*  constraints  will  usually  prune  all  but  a  handful  of  the  non-feasible 
interpretations  from  the1  IT.  The  pruning  often  occurs  very  early  in  the  generation 
process,  eliminating  large  subtrees  from  consideration.  Il  is  important  to  note  that 
the  constraints  will  not  generally  reject  all  impossible  interpretations.  Suppose,  for 
example,  that  the  interpretation  j(.Sj  W,„)(.Sj  VV  „ ) ,  easily  passes  the  distance  con¬ 
straint,  even  though  .S,  and  must  eventually  be  situated  within  two  relatively 
small  intervals  on  IV  m  and  VV„.  This  restriction  on  the  positions  of  .S’,  and  is 
ignored  at  further  generation  steps,  since  further  sonar  segments  will  be  required  to 
be  distant e-coiisislent  with  the  full  lengths  of  VPm  and  IV’„,  instead  of  the  small  in¬ 
tervals  implied  by  the  previous  pairings.  In  order  to  guarantee  that  all  the  available 
geometric  constraints  on  the  sonar  segments  are  used,  we  use  the  global  model  test, 
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Figure  9:  A  situation  illustrating  the  usefulness  of  the  directed  angle  concept. 

in  a  few  extreme  cases  of  possible  sonar  segment  orientations  and  positions 
relative  to  walls. 

The  local  constraints  described  above  are  described  in  greater  detail  in  jCaston 
&  Lozano-Perez  83 ! .  jGrimson  &  Lozano-Perez  83],  |Grimson  84],  and  |l)rumheller 
84  i. 

Using  these  constraints,  the  IT  is  expanded  in  the  following  way:  At  the  first  level 
in  the  IT,  .S',  is  allowed  to  be  paired  with  each  wall  that  is  longer  than  it,  sinre  none  of 
the  above  local  constraints  (which  are  all  pairwise)  applies  to  solitary  sonar  segments. 
Below  the  j(.S,  lV,)i  node  at  the  second  level,  S2  is  paired  with  each  wall  W';  that  is 
consistent,  based  on  the  local  constraints,  with  the  pairings  ](.9,  IV’,)(.S’2  lVy ) . .  Below 
the  node  (.S',  11, ) ( ,S'2  W'*)1  at.  the  third  level,  is  paired  with  each  wall  H',  that  is 
consistent  with  the  pairings  , ( .S’ ,  W,)(.S  W',)|  and  ](S2  Wk ) ( .S'-.  U/)l.  Note  that  for  a 
segment-wall  pairing  to  be  consistent,  it  must  be  consistent  with  every  pairing  that 
leads  to  it  on  a  path  through  the  IT.  Thus,  for  a  three-segment  interpretation  tin' 
local  constraints  must  be  applied  to  three  segment-wall  pairings,  and  in  general  (*) 
pairings  for  k  sonar  segments. 

The  above  constraints  will  usually  prune  all  but  a  handful  of  the  non-feasible 
interpretations  from  ihe  IT.  The  pruning  often  occurs  very  early  in  the  generation 
process,  eliminating  large  subtrees  from  consideration.  It  is  important  to  note  that 
the  constraints  will  nol  generally  reject  all  impossible  interpretations.  Suppose,  for 
example,  that  the  interpretation  j ( .S’,  Vt  Tn)(.S';  M„)  easily  passes  the  distance  con- 
’traint.  even  though  S,  and  S}  must  eventually  be  situated  within  two  relatively 
small  int'  -  als  on  \Ym  and  W„.  This  restriction  on  the  positions  of  .S’,  and  is 
ignored  at  further  generation  steps,  since  furt  her  sonar  segments  will  be  required  to 
be  distance-consistent  with  t lit’  full  lengths  of  \Vm  and  H’„,  instead  of  the  small  in¬ 
tervals  implied  by  the  previous  pairings.  In  order  to  guarantee  that  all  the  available  • 
geometric  constraints  on  the  sonar  segments  are  used,  we  use  the  global  model  test. 
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Figure  10:  The  geometry  of  the  normal  direction  constraint. 
which  is  described  later. 

Of  course,  the  above  constraints  are  not  the  only  ones  that  may  be  used  in  this 
kind  of  application.  They  were  chosen  because  they  are  very  simple  to  implement, 
and  because  similar  ones  have  been  shown  to  be  very  effective  despite  their  relative 
weakness;  refer  to  |Crimson  84]  and  (Crimson  &  Lozano-Perez  83]  for  results  that 
demonstrate  this  point. 

2.5.1  The  Global  Model  Test 

In  1  he  global  model  test  we  seek,  for  each  surviving  interpretation,  a  translation 
and  rotation  ol  the  sonar  contour  that  will  superpose  each  sonar  segment  onto  the 
wall  with  which  it  is  paired.  In  this  paper  we  use  a  simple  averaging  scheme  as 
follow  s: 

To  find  the  orientation  of  the  sonar  contour,  we  assume  that  each  segment  lies 
Hat  against  its  assigned  wall.  Thus,  each  segment-wall  pairing  implies  a  particular 
orientation  for  the  sonar  contour  with  respect  to  the  room.  The  average  of  these 
orientations  is  taken  to  be  the  actual  value  of  the  orientation  of  the  sonar  contour. 

To  determine  the  proper  translation,  vve  take  each  pair  of  pairings  in  the  in¬ 
terpretation  and  determine  the  translation  that  causes  the  midpoints  of  the  sonar 
segments  to  intersect  their  assigned  walls,  given  the  sonar  contour  orientation  de¬ 
termined  above.  (A  compact  algorithm  for  computing  this  translation  appears  in 
Crimson  A-  Lozano-Perez  83].)  The  average  of  these  translations  is  taken  as  the 
actual  value  of  the  translation  of  the  sonar  contour.  Note  that  a  pair  of  pairings  in 
which  both  sonar  segments  or  both  walls  are  parallel  to  each  other  does  not  help  to 
locate  the  robot  uniquely.  Therefore,  the  translation  contribution  from  such  pairs  is 
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ignored. 

Omo  we  have  determined  the  configuration  implied  bv  a  particular  interpretation, 
we  check  to  be  sure'  the  endpoints  of  each  sonar  segment  lie  within  E  of  the  wall  with 
which  it  is  paired.  We  must  also  check  to  be  sure-  that  each  sonar  segment  lies  within 
E  of  the  finite  bounds  of  those  walls.  (Since  the  walls  are  described  as  segments, 
nol  infinite  lines,  it  is  possible  that  some  sonar  segments  may  be  transformed  to  lie 
beyond  the  endpoints  of  the  walls,  which  would  disqualify  an  interpretation.) 

2.5.2  The  Inside  Tost 

The  global  model  test  includes  a  simple  check  to  make  sure  that  the  interpretation 
under  consideration  localizes  the  robot  to  lie  inside  the  room.  This  procedure  uses 
the  well  known  fact  that  a  point  lie's  inside  a  closed  contour  if  and  only  if  ra\  drawn 
from  the  point  to  infinity  intersects  the  contour  an  odd  number  of  times. 

2.6  The  Sonar  Barrier  Test 

There  is  one  final  test  that  each  interpretation  surviving  the  global  model  test 
must  pass:  An  admissible  interpretation  must  not  imply  that  the  sonar  beam  pene¬ 
trates  any  walls  from  inside  their  cone  of  reflection. 

Figure  11  illustrates  this  point.  After  we  have  performed  the  global  model  test 
we  are  left  with  a  set,  which  may  be  empty,  of  possible  sonar  contour  (and  thus 
robot)  configurations.  For  example,  in  Figure  11,  each  proposed  localization  may 
have  surv  ived  all  of  the  local  constraints  and  even  the  global  model  test. 

However,  only  the  lower  left  configuration  in  Figure  1 1  is  physically  possible,  since 
it  is  the  only  one  that  does  not  imply  that  the  sonar  beam  penetrates  a  solid  wall 
from  inside  the  cone  of  reflection  for  that  wall.  Note  that  admissible  interpretations 
often  imply  that  the  beam  penetrates  a  wall  from  outside  the  CR  for  that  wall.  This 
situation  is  perfectly  acceptable,  since  it  does  not  violate  any  physical  laws. 

Therefore,  whenever  w<e  find  an  interpretation  that  passes  the  global  model  test, 
we  perform  the  sonar  barrier  lest,  as  follows: 

•  Attempt  to  find  a  sonar  ray  that 

intersects  any  wall, 

-  lies  within  the  cone  of  reflection  for  the  wall, 

-  has  its  endpoint  outside  the  wall  by  more  than  a  small  amount: 

•  If  any  such  ray  exists,  then  discard  the  interpretat  ion  and  the  localization,  since 
they  imply  a  physically  impossible  situation. 

Note  that  the  amount  by  which  a  sonar  ray  must  lie  outside  the  wall  is  not 
necessarily  E.  We  can  afford  to  use  a  smaller  error  bound,  called  E„  (for  “normal 
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Figure  11:  These  are  two  feasible  localizations  based  on  the  interpretations 
(.V,  Mj)(S2  M's)!  (lower  left)  and  |(5i  M^K-S^  VV2)}  (upper  right).  Given  the  cone 
of  reflection  as  shown,  the  upper  right  localization  would  fail  the  sonar  barrier  test 
because  the  heavy  black  segments  apparently  penetrate  wall  from  inside  the  cone 
of  reflection. 


error”),  since  we  are  checking  the  error  of  sonar  rays  that  we  know  to  be  almost 
normal  to  a  wall  (recall  section  2.1.1). 

The  program  would  be  highly  inefficient  if  it  carried  out  the  search  for  “penetrat¬ 
ing  ra>s"  in  exactly  the  manner  just  described.  Instead,  the  program  first  finds  all 
walls  containing  at  least  one  point  such  that  a  ray  drawn  from  the  robot  location  to 
the  point  lies  within  the  Cl?  for  the  wall.  Then  it  checks  only  the  sonar  ravs  that  fall 
inside  the  CHs  ol  those  walls.  In  Figure  12,  for  example,  only  the  walls  marked  in 
heavy  black  would  be  chosen  for  the  test,  and  only  the  heavy  black  sonar  rays  would 
be  inspected  for  penetration  of  them. 

The  sonar  harrier  test  can  be  very  effective  at  pruning  incorrect  localizations  that 
survive  the  local  constraints  and  the  global  model  test,  ll  is  common  to  have  more 
than  ten  localizations  that  satisfy  all  of  t  he  local  constraints  and  the  global  model  test, 
with  only  one  of  them  passing  the  sonar  barrier  test.  This  can  happen,  for  example, 
when  the  robot  is  located  near  an  isolated  corner  in  the  building.  In  this  case  the 
sonar  segments  often  form  a  small  L-shaped  pattern.  This  arrangement  of  sonar 
segments  does  not  help  to  select  a  particular  corner  in  the  building,  since  all  corners 
are  locally  identical.  The  sonar  barrier  test  uses  the  global  information  contained  in 
the  rest  of  the  sonar  contour  to  determine  which  corner  the  robot  occupies. 

U 
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^  Figure  12:  Given  the  sonar  contour  and  cone  of  reflection  as  shown,  the  sonar  rays 

and  walls  drawn  m  heavy  black  would  be  used  in  the  sonar  barrier  test. 

2.7  Ignoring  Clutter  and  Other  Bad  Data 

Sonar  contours  often  contain  a  sonar  segment  that  is  not  the  sonar  image  of 
any  wall  included  in  the  room  model.  Such  a  sonar  segment  could  be  produced 
by  sonar  noise  or  clutter,  as  described  in  section  2.2.  It  is  impossible  to  find  an 
interpretation  that  assigns  such  a  sonar  segment  to  a  wall  in  a  geometrically  consistent 
way.  Unfortunately,  it  is  also  impossible,  using  the  process  described  so  far.  to 
distinguish  between  a  violation  of  the  local  constraints  due  to  an  unfeasible  wall 
assignment  and  a  violation  due  to  the  presence  of  a  clutter  segment. 

It  may  still  be  possible  to  find  an  interpretation  of  all  the  sonar  segments,  includ¬ 
ing  the  clut  ter  segments,  that  is  consistent  with  the  local  pruning  constraints.  In  fact, 
it  is  even  possible,  by  a  fortuitous  alignment  of  the  data,  for  interpretations  involving 
clutter  segments  to  pass  the  global  model  test.  However,  such  “freak"  interpretations 
are  almost  always  eliminated  by  the  sonar  barrier  test. 

We  can  assume,  then,  during  this  discussion,  that  any  clutter  segment  will  cause 
all  interpretations  to  lx-  inconsistent  (except  in  rare  cases).  This  poses  a  serious 
problem  lor  our  approach,  as  it  is  descr  bed  so  far,  since  all  interpretations  would  be 
eliminated  if  just  one  of  the  sonar  segments  was  clutter. 

A  straight  forw  ard  way  of  handling  this  problem  would  be  to  apply  the  matching 
process  to  all  subsets  of  the  set  of  sonar  segments,  which  would  guarantee  that 
a  clutter-free  set  of  sonar  segments  would  be  considered  (if  one  existed).  But,  of 
course,  this  approach  wastes  much  work  determining  the  feasibility  of  the  same  partial 
interpretations.  There  is  a  way,  however,  to  consider  all  subsets  of  the  data  without 
wasting  the  work  of  testing  paitial  interpretations.  This  method  was  introduced  in 
ILoeano-Peret  h  Grimson  84),  and  is  described  as  follows: 

Consider  the  addition  of  one  more  branch  to  each  node  of  the  IT  (see  Figure  13). 
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Figure  13:  The  IT  with  the  null  wall  branch  added 

This  branch  represents  the  possibility  that  the  sonar  segment  for  that  level  of  the  IT 
is  the  image  of  a  piece  of  clutter,  i.e.,  that,  it  should  not  be  assigned  to  any  wall.  We 
will  call  this  branch  the  null  wall,  or  W*  .  The  remainder  of  the  process  operates  as 
before  except  that,  when  applying  the  local  constraints,  the  null  wall  acts  as  a  “wild 
card,’"  i.e..  it  survives  all  of  the  local  constraints,  so  that  assigning  a  sonar  segment 
to  W  never  causes  the  failure  of  an  interpretation.  Thus,  at  every  node  thal  we 
visit  in  the  IT.  we  assign  the  sonar  segment  under  consideration  to  the  null  wall,  to 
represent  the  possibility  thal  the  sonar  segment  is  clutter. 

It  is  eas\  to  set'  that  if  an  interpretation  is  admissible,  the  process  described  above 
w  ill  generate  all  subsets  of  this  interpretation  as  leaves  of  the  tree.  This  is  t  rue  of  par¬ 
tial  interpretations  as  well  as  full  interpretations.  Every  combination  of  assignments 
ol  the  null  wall  to  the  sonar  segments  will  still  produce  a  valid  interpretation,  which 
guarantees  that  if  any  subset  of  the  data  points  is  valid,  then  a  valid  interpretation 
will  be  obtained  as  a  leaf. 

However,  the  null  wall  feature  by  itself  greatly  decreases  the  efficiency  of  the 
algorithm,  since  it  causes  the  generation  of  all  subsets  of  valid  interpretations.  We 
would  rather  generate  only  the  interpretations  that  are  consistent  with  as  many  as 
possible  of  the  sonar  segments.  The  following  method  guarantees  that  we  find  only 
the  most  complete  interpretations,  where  “most  complete”  means  “containing  the 
fewest  null-wall  pairings.” 

The  IT  is  explored  in  a  depth-first  fashion,  with  the  null  wall  considered  last  when 
expanding  a  node.  In  addition,  the  global  model  test  is  applied  to  any  interpretation 
that  is  a  leaf  of  the  IT.  Now,  suppose  we  use  a  global  variable,  called  BEST ,  to  record 
the  number  of  non-null  pairings  that  occur  in  the  most  complete  interpretation  found 
so  far.  As  we  expand  the  IT,  we  should  assign  a  sonar  segment  .S’,  to  the  null  wall  only 
if  m  I  (.s  ?)  BEST,  where  m  is  the  number  of  non-null  pairings  in  the  current 


< 
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node,  .s  is  the  total  number  of  sonar  segments,  and  i  is  the  depth  of  the  eurrenl 
node  in  the  IT.  Otherwise,  the  number  of  non-null  pairings  in  interpretations  at  all 
the  leaves  below  this  node  will  be  less  than  that  of  the  most  complete  interpretation 
already  found.  If  we  initialize  BEST  to  some  non-zero  value  (usually  two,  since  a 
unique  localization  requires  at  least  two  sonar  segments),  then  only  interpretations 
with  this  number  of  non-null  pairings  or  greater  will  be  found.  Each  time  a  more 
complete  interpretation  is  found,  the  value  of  BEST  is  incremented,  thus  ensuring 
that  we  line!  the  most  complete  interpretation  for  the  data.  Note  that  if  BE  SI'  ever 
reaches  .s,  then  no  null-wall  assignments  will  have  been  made. 

2.7.1  An  Added  Heuristic 

In  the  rare  event  that  all  of  the  above  procedures  fail  to  produce  a  unique  in¬ 
terpretation,  then  the  interpretation  that  maximizes  the  sum  of  the  lengths  of  sonar 
segments  in  non-null  pairings  is  chosen  as  the  final  answer.  This  action  expresses 
our  preference  for  interpretations  based  on  long  sonar  segments,  which  are  less  likely 
to  be  clutter  segments.  Note  that  the  occurrence  of  multiple  interpretations  is  still 
possible. 

3  Results 

The  algorithm  described  in  this  paper  has  been  run  on  real  sonar  data.  The 
following  section  describes  some  of  the  results  from  these  experiments. 

3.1  The  Experimental  Setting 

Sonar  data  was  obtained  from  three  different  rooms  in  the  Artificial  Intelligence 
Laboratory  at  MIT.  The  room  outlines  are  shown  in  Figures  14.  15.  and  Hi.  Next 
to  each  room  outline  is  a  photograph  taken  from  inside  the  room.  The  photographs 
are  intended  to  give  the  reader  a  rough  idea  of  how  cluttered  and  “real”  these  rooms 
are. 

Figures  17  through  24  show  some  typical  results  from  each  of  the  three  rooms. 
The  robot's  actual  position  was  measured  by  hand  with  a  tape  measure  and  a  pro¬ 
tractor;  it  is  accurate  to  within  an  inch  or  two  and  aboul  five  degrees.  The  surviving 
interpretations  and  their  corresponding  conligurat  ions  are  printed  directly  below  each 
drawing.  The  actual  configuration  is  also  printed.  In  each  drawing,  the  robot’s  actual 
configuration  is  represented  by  the  outline  of  a  Iriangle  with  a  small  circle  inside  it. 
The  robot’s  sonar-determined  configuration  is  represented  by  a  solid  white  triangle 
with  a  cross  in  the  center.  Thus,  the  accuracy  of  a  localization  can  be  judged  ei¬ 
ther  by  reading  the  printed  numerical  results  or  by  observing  the  alignment  of  the 
triangles,  the  cross,  and  the  cir<  le. 

The  program  parameters  were  the  same  for  all  of  these  results.  They  are  not 
optimal,  since  they  were  chosen  based  upon  only  a  small  amount  of  experimentation 
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and  1  he  author’s  estimates  of  sonar  range  data  errors.  In  terms  of  variables  ment  ioned 
previously  in  the  text,  the  program  parameters  were: 

•  E  1.3  ft.  (maximum  error  for  a  sonar  ray  endpoint), 

•  E,;,  10  degrees  (maximum  angular  error  for  a  sonar  segment), 

•  A  7  (minimum  number  of  points  in  a  sonar  segment), 

•  <S  0.5  ft.  (maximum  perpendicular  deviation  for  points  in  a  sonar  segment), 

•  ~i  -  7  degrees  (CR  half-angle), 

•  E„  -  0.7  ft.  (maximum  error  for  a  sonar  ray  known  to  be  nearly  perpendicular 
to  a  wall) 

Note  that  satisfactory  results  were  obtained  by  assuming  that  all  walls  have  a 
CR  half  angle  -y  equal  to  that  of  the  most  reflective  surface  that  could  possibly  be 
encountered,  namely,  a  smooth  glass  window  (for  which  7  <  10  degrees). 

The  program  has  been  run  on  24  sonar  contours  so  far.  Seventeen  of  the  sonar 
contours  yielded  a  localization  that  was  correct  to  within  one  foot  in  any  direction  and 
about  five  degrees  in  orientation.  Two  localizations  were  dead  wrong,  i.e.,  they  were 
in  error  bv  more  than  one  foot.  The  five  sonar  contours  that  yielded  no  localization 
failed  for  one  of  of  the  following  reasons: 

•  ihe  sonar  contour  contained  only  one  sonar  segment,  or  none  at  all, 

•  the  sonar  segments  were  either  parallel  or  paired  with  parallel  walls,  a  situation 
which  can  nol  produce  a  unique  localization. 

We  have  seen ,  both  intuitively  and  from  experience  with  the  algorithm,  that  it  t s 
unlikely  that  a  localization  based  on  a  correct,  interpretation  will  be  in  error  by  a  targe 
amount .  This  means  that  dead-wrong  localizations  are  usually  based  upon  incor¬ 
rect  interpretations.  Since  incorrect  interpretations  usually  result  only  from  “freak” 
alignments  of  the  data,  incorrect  localizations  also  tend  to  be  completely  anomalous, 
having  very  large  errors.  This  behavior  could  be  desirable  in  the  localization  module 
of  a  real  robot  navigation  system,  since  proposed  configurations  that  are  extremely 
different  from  recently  determined  configurations  could  be  dismissed  as  obviously 
wrong.  Largo  localization  errors  could  be  used  as  an  indication  that  the  robot  should 
move  slightly  and  try  the  algorithm  again,  or  use  another  sensing  approach. 

The*  program  was  developed  in  Lisp  on  a  Symbolics  3600  Lisp  Machine.  It  usually 
takes  about.  5  seconds  (after  data  acquisition)  to  localize  the  robot,  but  it  has  taken 
as  long  as  15  seconds  for  sonar  contours  containing  a  large  amount  of  clutter. 
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4  Conclusions 

Mobile  robot  localization  can  be  performed  quickly  and  reliably  with  a  low- 
resolution,  noisy  rangefinder.  The  first  step  in  the  process  is  to  reduce  the  size 
of  the  set  of  possible  robot  configurations  by  considering  the  possible  pairings  of 
wall-like  data  features  with  walls  in  the  room  model,  pruning  inconsistent  pairings 
using  local  geometric  constraints.  The  key  to  rejecting  incorrect  configurations  that 
often  persist  in  the  resulting  set  of  possible  configurations  is  to  exploit  global  geo¬ 
metric  constraints,  derived  from  simple  physical  laws,  on  the  shape  of  a  real  sonar 
range  contour. 

The  sonar  data  shown  in  this  paper  is  so  noisy  and  of  such  low  resolution  that  it 
nearly  constitutes  a  “worst  case  scenario”  for  range  data.  The  author  believes  that 
the  program’s  performance  would  be  greatly  enhanced  by  the  use  of  a  high-resolution 
laser  rangefinder,  such  as  the  one  described  in  (Jarvis  83j. 
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Figure  14:  Outline  and  photograph  of  the  largest  room  tested ,  called  HKl-HM. 


Figure  1">:  Outline  and  photograph  of  the  medium-sized  room  (MED- HM). 


Figure  Hi:  Outlive  and  photograph  of  the  smallest  room  li  sted  (SMA  LL-HM). 
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C<  SI  W1XS2  U4XS3  W3)3;  *  =  -28.9  ft.  y  =  23.9  ft.  168  deg- 
Actual  co.nf  igurat  ion  was:  K  =  -29.3  ft.  y  —  24.6  ft.  170  deg. 

Figure  17:  Typical  solution  for  BIG-RM.  Note  that  the.  lower  portion  of  the  sonar 
contour  contains  large  errors  due  to  edge-of-beam  reflection.  (Recall  Figure  4.) 


Actual  coof  igurat  •ion  was:  x  &  -3.5  ft.  y  *  42.1  ft.  99  dag. 


Figure  18:  In  this  example,  the  indentation  in  the  sonar  trace  was  produced  when  the 
beam  just  barely  caught  the  top  of  the  head  of  a  small  person  standing  nearby.  The 
program  successfully  ignored  the  clutter.  Note  that  the  lack  of  global  similarity  between 
the  sonar  contour  and  the  room  outline  does  not  affect  the  localization  process. 
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Figure  19:  In  this  localization,  the.  segments  S]  and  .S'2  serve  to  select  any  corner 
configuration.  The  lower  right  configuration  is  selected  because  -it  causes  to  fit 


Figure  20:  This  sonar  contour  is  similar  to  the  contour  in  Figure  19,  except  for  some 
deliberately  introduced  clutter  (  S: ,  and  St,).  The  clutter  segments  were  successfully 


[(SI  U1HS2  U* ) ( S3  M3)];  x  =  5.8  ft.  y  *  8.1  ft.  0  deg. 

Actual  configuration  was;  k  =  5.8  ft.  y  =  8.1  ft.  0  deg. 

Figure  21:  A  typical  result,  from  inside  MED-RM.  Notice  the  prominent  horns  caused 
by  false  reflections. 


t(Sl  M»)(S2  M3) (S3  M6HS4  U»)(S5  W«)(S6  M3) (S3  M*)(S8  U*)](  k  «  18.3  ft.  y  .  8.4  ft.  -86  <*•«. 

Retual  eonf <9uP»t1on  uaa:  x  *  18.3  ft.  y  «  8.3  ft.  -98  8a*. 

Figure  22:  In  this  case  .S',  should  have  been  assigned  to  the.  lower  wall.  However, 
the  resulting  interpretation  would  have  been  less  complete,  since  almost  every  other 
segment  would  have  been  assigned  to  the  null  wall. 
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[(SI  U1 ) ( S2  U»XS3  U3XS4  U2XS5  U4XS6  U»XS7  »*)];  *  =  -7.4  ft. 

Actual  configuration  was:  x  =  -7.2  ft.  y  =  6.2  ft.  90  deg. 

Figure  23:  A  typical  result  from  inside  SMALL-RM. 


[(SI  U2HS2  U3) (S3  M1XS4  U4XS5  U»XS6  U*XS7  U»>]j  x  =  -7.4  ft.  y  r  6.0  ft.  91  deg. 

Actual  eonfiguretion  ue>:  k  a  -7.2  ft.  y  =  6.2  ft.  90  deg. 

Figure  24:  The  same  sonar  contour  as  in  Figure  28,  with  a  tall  person  standing 
nturby  in  an  attempt  to  inhibit  localization.  I  he  clutter  was  successfully  ignored. 


